03. Full SLAM

Full SLAM

Full SLAM Problem

  • At time t-1, the robot will estimate the robot pose xt-1 and map m, given the measurements **zt-1 **and controls ut-1.
  • At time t, the robot will estimate the entire path xt-1:t and map m, given all the measurements zt-1:t and controls ut-1:t.
  • At time t+1, the robot will estimate the entire path xt-1:t+1 and map m, given all the measurements zt-1:t+1 and controls ut-1:t+1.

This problem can be modeled with the probability equation p(x1:t , m | z1:t u1:t), where we solve the posterior represented by the robot's trajectory x1:t and the map m given all the measurements z1:t and controls u1:t. Thus, with full SLAM problem we estimate all the variables that occur throughout the robot travel time.

How will the robot solve the Full SLAM problem from t-1 to t+2?

SOLUTION: The robot will estimate the robot's trajectory “xt-1:t+2” and map “m” given the measurements “zt-1:t+2” and controls “ut-1:t+2